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DESCRIPTION 

ROBOT APPARATUS AND DEVICE AND METHOD FOR CONTROLLING MOTION 
OF THE ROBOT APPARATUS 

5 

Technical Field 

The present invention relates to a robot apparatus 
having at least a plurality of movable legs, and a device 
and method for controlling the motion of the robot apparatus. 

10 More particularly, the present invention relates to a robot 
apparatus capable of motion having a floor contact period 
and a floor non-contact period, such as running or hopping, 
in addition to motion having only a floor contact period, 
such as walking; and a device and a method for controlling 

15 the motion of the robot apparatus. 

Even more particularly, the present invention relates 
to a robot apparatus capable of seamlessly changing between 
walking/stopping states and running/hopping or jumping 
states while properly maintaining dynamic balance even 

20 during a change between irregular floor contact motion and 
floor non-contact motion, and a device and method for 
controlling the motion of the robot apparatus. Still even 
more particularly, the present invention relates to a robot 
apparatus which can generate in real time a stable motion 

25 pattern for changing between a floor contact motion and a 
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floor non-contact motion; and a device and a method for 
controlling the motion of the robot apparatus. 

Background Art 

5 A robot is a mechanical device which moves like a human 

being by making use of electric and magnetic actions. The 
term "robot" is said to be derived from the Slavic word 
"ROBOTA" (slavish machine) . In our country, the widespread 
use of robots began at the end of the 1960s, many of which 

10 were industrial robots, such as manipulators and conveyance 
robots, used, for example, for the purpose of achieving 
automatic industrial operations in factories without humans 
in attendance. 

In recent years, advances have been made in the 

15 research and development of legged mobile robots which are 
designed using as a model the motion and mechanism of the 
body of an animal, such as a human being or an ape, which 
moves erect using two feet. There are increasing 
expectations for putting such robots into practical use. 

20 Legged mobile robots which reproduce the motions and bodily 
mechanisms of a human being are called humanoid robots. 

Bipedal motion in an erect orientation is unstable 
compared to, for example, crawling or motion using four or 
six legs. Therefore, in this case, the orientation - and 

25 walking are difficult to control. However, bipedal motion 
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in an erect orientation is advantageous in that it is a 
flexible motion. Therefore, robots capable of such a motion 
can, for example, move along a walking surface of a working 
path, such as a rough surface or a surface having obstacles, 
5 or move along a discontinuous surface, such as moving up and 
down steps or a ladder. 

Many technologies for controlling the orientation of 
and allowing stable walking of bipedal mobile robots have 
already been proposed. Here, "stable walking" means "moving 

10 using the legs without falling." Controlling the 

orientations of robots for achieving stable orientations is 
very important in preventing the robots from falling. One 
reason is that, when robots fall, they stop performing their 
tasks, as a result of which considerable time and labor are 

15 required for the robots to get up and re-start their actual 
tasks again. Another reason is that, when robots fall, the 
robots themselves or objects against which the falling 
robots strike may be fatally damaged. 

Many of the technologies for controlling the 

20 orientations of legged mobile robots or preventing them from 
falling while walking make use of ZMP (zero moment point) as 
a norm for determining the degree of walking stability. The 
norm for determining the degree of walking stability by ZMP 
is based on D'Alembert's principle in which gravitation and 

25 inertial force from a walking system to a floor surface and 
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their moments balance floor reaction force and floor 
reaction moment from the floor surface to the walking system. 
The inference in terms of dynamics is that there is a point , 
that is, a ZMP where a pitch axis moment and a roll axis 
5 moment are zero on or within a side of a supporting polygon 
(that is, a ZMP stable area) defined by a floor surface and 
the points of contact of the soles with the floor. (Refer 
to, for example, "Legged Locomotion Robots" by Miomir 
Vukobratovic 1 , and "Hoko Robot to Jinko no Ashi" by Ichiro 

10 Kato and published by The Nikkan Kogyo Shinbun Ltd.) 

In summary, at any instant of walking, ZMP exists 
within the supporting polygon defined by the feet and floor 
surface and is a point allowing a robot to walk stably 
without falling (rotary motion of the body) as long as the 

15 robot exerts a force upon the floor surface in a pushing 
direction . 

According to a bipedal walking pattern based on ZMP, 
the points where the soles contact the floor can be 
previously set, so that, for example, it is easy to consider 

20 kinematic constraints on the ends of the feet in accordance 
with the shape of the floor surface. When ZMP is used as a 
norm for determining the degree of stability, a trajectory 
instead of force is used as a target value for controlling 
motion. Therefore, technically speaking, the probability 

25 putting ZMP into practical use is increased. 




The mode of motion of most of the related legged mobile 
robots is walking in which either leg is always in contact 
with the floor surface- For legged mobile robots for 
ordinary use, walking is a safe, efficient, and optimal mode 
5 of motion because excessive force is not applied to a 
mechanical /electrical system. 

Motion having a floor non-contact period in which 
reaction from the floor is not received is a situation in 
which it is not sufficient for legged mobile robots to have 

10 only a walking function. When legged mobile robots move in 
contact with the floor where there is gravity, they are not 
continuously in a floor non-contact state for a long period 
of time. However, they may be in a floor non-contact state 
for a short period of time or discontinuously . Examples of 

15 such situations are jumping across a gap, jumping down from 
a higher level, running to move faster, and changing the 
standing position by hopping for maintaining balance. 

There are still not many examples of research on 
controlling balance when such legged mobile robots are not 

20 in contact with a surface. Outstanding pioneering 

researches are disclosed in, for example, "Hanpuku Choyaku 
Model Biomechanism 5," 1985, published by University of 
Tokyo Press, Kiyotoshi Matsuoka, pp. 4501-4509; and the 
International Journal of Robotics Research, vol. 3, No. 2, 

25 1984, Marc H. Raibert and two other: "Experiments in 
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Balance with a 3D One-Legged Hopping Machine," pp. 75-92. 
However, these researches have not been successful in 
providing a practical control system of legged mobile robots 
for the following reasons. 
5 CD Since massless legs are assumed, considerable limitations 
are placed on mechanical designing freedom. 

® Since only continuous hopping or jumping is assumed, the 
dynamics regarding transition to a walking state or stopped 
state is not satisfactorily studied. 

10 CD It is difficult to impose geometrical constraints on the 
trajectories of the ends of the feet. 

A method of calculating a motion pattern of a legged 
mobile robot when floor contact and floor non-contact 
conditions are mixed by expanding the use of the ZMP norm is 

15 disclosed in "Dorikigaku Filter ni yoru Ningengata Robot no 
Zenshin Undo Seisei, " authored by Keiichiro Nagasaka, in 
Tokyo Daigaku Kogakubu Joho Kogaku Senko Hakase Ronbun, 1999. 
However, according to this document, since a convergence 
calculation is performed to solve a nonlinear equation, the 

20 calculation load is high, making it necessary to previously 
calculate a motion pattern offline. In other words, a 
motion pattern having a floor contact period and a floor 
contact period in, for example, walking, running, or hopping, 
cannot be generated in real time. 

25 As described above, today, the method of calculating a 



motion pattern based on a ZMP norm is the dominant basic 
controlling method for controlling the motion of a legged 
mobile robot. The greatest merit of using the ZMP as a norm 
for determining the stability of the body of a robot is that 
5 it is of high practical use, such as ZMP easily providing 
geometrical constraints on the ends of the feet or being 
applicable to a wide range of mechanical models , etc. For 
example, there is a report about a structure of a flexible 
control system based on a technology of generating walking 

10 pattern a real time in order to allow a robot to walk while 
generating a stable motion pattern on board during its 
motion, (Refer to, for example, Japanese Patent Application 
No. 2002-288745 already assigned to the applicant.) 

As mentioned above, practical controlling means for 

15 motion including a floor non-contact period, such as in 
walking/hopping, has not yet been proposed. 

The first problem that prevents legged motion including 
a floor contact period and a floor non-contact period from 
being practically realized is that most of the controlling 

20 methods impose many limitations regarding mechanical models. 
In particular, since many of the methods ignore the masses 
of the legs because it is difficult to handle changes in 
inertia of a robot caused by leg motions above a surface, 
these methods cannot be applied to many practical legged 

25 mobile robots. (Refer to, for example, "Hanpuku Choyaku 
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Model Biomechanism 5," 1985, published by University of 
Tokyo Press, Kiyotoshi Matsuoka, pp. 4501-4509; and the 
International Journal of Robotics Research/ vol. 3, No. 2, 
1984, Marc H. Raibert and two other: "Experiments in 
5 Balance with a 3D One-Legged Hopping Machine," pp. 75-92.) 

Typical present-day humanoid robots have at least six 
degrees of freedom in one leg. Although such a legged 
mobile robot having many degrees of freedom in its leg 
requires many actuators, it is difficult to mount all of 

10 these many actuators to its main body (portion of the body 
near the center of gravity, such as the waist) , and a 
considerable number of actuators are installed in the legs 
(probably to prevent accidental torque interference by wire 
conduction.) In the first place, the legs support the 

15 entire weight of a legged mobile robot, and, thus, must have 
mechanical strength. Therefore, the structural members have 
considerable weight . 

Therefore, in general, the masses of the legs are 
increased, and, thus, cannot be ignored in a dynamic model. 

20 Consequently, it is difficult to apply related techniques to 
legged mobile robots having large leg masses. 

The second problem is that the number of 
running/hopping controlling algorithms for allowing 
transition between walking and stopping states is small. 

2 5 As already mentioned above, a legged mobile robot 
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rarely runs or hops constantly, and, thus, is often in a 
stopped state or a walking state. When necessary, the robot 
is made to run/hop, after which it is made to walk or stop 
again. Depending upon the circumstances, a robot may 
5 suddenly hop from a floor contact state, or may walk 

gradually faster and run, and, then, smoothly slow down, 
walk, and stop again. 

There is an earnest desire for a general controlling 
method which makes it possible to perform seamless motion 
10 changes even between various, irregular contact and non- 
contact motions while properly maintaining dynamic balance. 

The third problem is that most of the running/hopping 
or jumping controlling methods cannot add geometrical 
constraints. 

15 In particular, there are many situations in which 

geometrical constraints are to be imposed upon 
position/orientation trajectories of feet end points in an 
inertial coordinate system. There are many methods of 
manipulating a floor contact point in order to maintain 

20 balance of the body of a robot. In order to quantitatively 
control a legged mobile robot, it is desirable that the 
trajectories of the feet ends be capable of being manifestly 
specified. For example, it is desirable that parameters, 
such as walking footstep/period or the heights of the soles 

25 when hopping or jumping, be capable of being specified by a 



user program. When the robot is required to, for example, 
run up steps or jump over a plurality of successive gaps, it 
is not desirable to manipulate the trajectories of the feet 
ends for maintaining balance. 

The method of controlling walking by generating a 
walking pattern based on a ZMP norm is very advantageous 
from the practical point of view in that it can impose such 
motion constraints. This advantage is also demanded when 
the use of a ZMP norm is expanded to a motion having a floor 
non-contact period. 

The fourth problem is that there is an earnest demand 
for a method which can change a motion pattern in real time 
so as to satisfy an asynchronous outside request. 

In order to allow free motion of a legged mobile robot 
in an actual environment, it is necessary to provide a 
function for immediately re-planning the motion of the whole 
body while maintaining dynamic balance so as to satisfy a 
request for a change in the motion of the upper part of the 
body and a request for a change in crural motion, such as 
footstep, step period, angle of traverse, or feet lifting 
height, input at various timings. Previously forming a 
motion pattern offline will not satisfy such requests. In 
addition, it is difficult to satisfy the aforementioned 
outside requests by a control system which only maintains 
balance. 
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Disclosure of Invention 

Accordingly , it is an object of the present invention 
to provide an excellent robot apparatus capable of motion 
5 having a floor contact period and a floor non-contact period, 
such as in running and hopping, in addition to motion having 
only a floor contact period, such as in walking; and a 
device and a method for controlling the motion of the robot 
apparatus . 

10 It is another object of the present invention to 

provide an excellent robot apparatus capable of seamlessly 
changing between walking/stopping states and running/hopping 
or jumping states while properly maintaining dynamic balance 
even during a change between irregular floor contact motion 

15 and floor non-contact motion; and a device and a method for 
controlling the motion of the robot apparatus. 

It is still another object of the present invention to 
provide an excellent robot apparatus which can generate in 
real time a stable motion pattern for changing between a 

20 floor contact motion and a floor non-contact motion, and a 
device and a method for controlling the motion of the robot 
apparatus . 

To overcome the aforementioned problems, the present 
invention provides a robot apparatus comprising: 
25 movable means; 
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center-of-gravity horizontal position trajectory 
determining means for solving a motion equation with a 
boundary condition regarding a center-of-gravity horizontal 
position trajectory of the robot apparatus so that the 
5 moment around a horizontal axis at a point within a support 
polygon defined by a plurality of portions of the movable 
means contacting a floor is zero or approximately equal to 
zero, and so that at least the position and speed of the 
center of gravity of the robot apparatus in a next control 

10 period are connected to the position and speed of the center 
of gravity of the robot apparatus in a current control 
period when the movable means is in contact with the floor; 

center-of-gravity vertical position trajectory 
determining means for solving a motion equation with a 

15 boundary condition regarding a center-of-gravity vertical 

position trajectory of the robot apparatus so that vertical 
translational force acting upon the robot apparatus other 
than gravity is equal to or approximately equal to zero, and 
so that the vertical position and speed of the center of 

20 gravity of the robot apparatus in the next control period 
are connected to the vertical position and speed of the 
center of gravity of the robot apparatus in the current 
control period when the movable means is not in contact with 
the floor; and 

25 motion state determining means for determining a motion 
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state of the robot apparatus in the next control period so 
that the moment around the center of gravity of the robot 
apparatus is equal to or approximately equal to zero, and so 
that the position of the center of gravity determined by the 
center-of-gravity horizontal position trajectory determining 
means and the center-of-gravity vertical position trajectory 
determining means is satisfied when the movable means is not 
in contact with the floor. 

The center-of-gravity horizontal position trajectory 
determining means, for example, calculates the center-of- 
gravity horizontal position trajectory of the robot 
apparatus based on the moment around the horizontal axis 
acting upon the robot apparatus and a temporal continuity of 
at least the position and speed of the center of gravity of 
the robot apparatus when movable means is in contact with 
the floor. The center-of-gravity vertical position 
trajectory determining means, for example, calculates the 
center-of-gravity vertical position trajectory of the robot 
apparatus based on vertical translational force acting upon 
the robot apparatus other than gravity and a temporal 
continuity of at least the vertical position and the speed 
of the center of gravity of the robot apparatus when the 
movable means is not in contact with the floor. The motion 
state determining means, for example, determines a motion 
state of the robot apparatus so that the moment around the 
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center of gravity of the robot apparatus and the position of 
the center of gravity determined by the center-of -gravity 
horizontal position trajectory determining means and the 
center-of -gravity vertical position trajectory determining 
5 means are satisfied when the movable means is not in contact 
with the floor. 

According to the robot apparatuses of the present 
invention, the center-of -gravity horizontal-position 
trajectory determining means and the center-of -gravity 

10 vertical-position trajectory determining means solve the 
motion equations with boundary conditions regarding the 
center-of-gravity horizontal-position trajectory and the 
center-of-gravity vertical-position trajectory for every 
control period- The motion state determining means 

15 determines the motion state of the robot apparatus for each 
control period while adjusting the moment around the center 
of gravity of the robot apparatus. Therefore, the motion of 
the robot apparatus can be controlled in real time. 

Here, the motion state determining means may determine 

20 the motion state of the robot apparatus in the next control 
period while adjusting the moment generated at the robot 
apparatus using Jacobian determined from a motion state of 
the robot apparatus in the current control period. 

The center-of-gravity horizontal position trajectory 

25 determining means may be such as to solve the motion 
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equation with the boundary condition regarding the center- 
of-gravity horizontal position trajectory of the robot 
apparatus so that ZMP where the moment around a pitch axis 
and the moment around a roll axis of the robot apparatus are 
5 zero exists within the support polygon instead of the moment 
around the horizontal axis at the point within the support 
polygon being equal to or approximately equal to zero when 
the movable means is in contact with the floor. 

The center-of-gravity horizontal position trajectory 

10 determining means may be such as to solve the motion 

equation with the boundary condition regarding the center- 
of-gravity horizontal position trajectory of the robot 
apparatus so that the horizontal momentum is substantially 
constant instead of the horizontal translational force being 

15 equal to or approximately equal to zero when the movable 
means is not in contact with the floor. 

The robot apparatus of the present invention may 
further comprise center-of-gravity position/speed measuring 
means for measuring the position and the speed of the center 

20 of gravity of the robot apparatus. In this case, the 

center-of-gravity horizontal position trajectory determining 
means and the center-of-gravity vertical position trajectory 
determining means can set the position and speed of the 
center of gravity of the robot apparatus in the current 

25 control period measured by the center-of-gravity 
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position/speed measuring means as an initial boundary 
condition of the next control period for the motion 
equations with the boundary conditions. 

The motion state determining means may determine the 
5 motion state of the robot apparatus using the orientation 
angle of a main body of the robot apparatus as a 
manipulation quantity. 

The motion state determining means may determine the 
motion state of the robot apparatus using a waist joint 
10 angle of the robot apparatus as a manipulation quantity. 

The motion state determining means may determine the 
motion state of the robot apparatus in the next control 
period so that the angular momentum around the center of 
gravity is constant instead of the moment around the center 
15 of gravity of the robot apparatus being equal to or 

approximately equal to zero when the movable means is not in 
contact with the floor. 

Other objects, features, and advantages of the present 
invention will become apparent from a detailed description 
20 of the present invention based on an embodiment described 
below and the attached drawings. 
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Brief Description of the Drawings 

Fig. 1 is a schematic view of the structure of a legged 
mobile robot of an embodiment showing its degrees of freedom. 
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Fig. 2 shows a state in which a constraint (dynamic 
constraint) is imposed upon a force f and a moment n which a 
motion pattern produces so that a combination of an external 
force F (= f) and an external moment (N = n) exists. 
5 Fig. 3 is a schematic view of a functions structure of 

a control system of the legged mobile robot of the 
embodiment of the present invention. 

Fig. 4 is a flowchart of the steps executed by the 
control system shown in Fig. 3. 
10 Fig. 5 shows examples of sole positions/orientation 

trajectories. 

Fig. 6 shows a state in which short intervals are 
consecutively set for N intervals. 

Fig. 7 shows a state in which short intervals of floor 
15 contact periods and short intervals of floor non-contact 
periods exist in the model in which short intervals are 
consecutively set for N intervals. 

Fig. 8 shows the relationship between a center-of- 
gravity position basic trajectory and a center-of-gravity 
20 position reference trajectory in the model in which short 
intervals and short intervals of floor non-contact periods 
exist . 

Fig. 9 is a flowchart of the steps executed by a 
center-of-gravity position trajectory generating unit 32. 
25 Fig. 10 shows the relationship between a main body 
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orientation basic trajectory and a main body orientation 
reference trajectory in the model in which short intervals 
and short intervals of floor non-contact periods exist. 

Fig. 11 is a flowchart of the steps executed by a main 
5 body orientation trajectory generating unit 33. 

Best Mode for Carrying Out the Invention 

The present invention provides a controlling method 
which makes it possible to generate a dynamically stable 
10 motion pattern in real time for a motion having a floor 

contact period and a floor non-contact period in a legged 
mobile robot. The controlling method of the present 
invention makes it possible for the legged mobile robot to 
move by immediately calculating a dynamically stable motion 
15 pattern while satisfying outside requests,, such as 

footstep/period, in a situation in which the legged mobile 
robot not only walks but also hops or jumps or runs or 
successively performs these motions. 

Hereunder, an embodiment of the present invention will 
20 be described in detail with reference to the drawings. 

Fig. 1 is a schematic view of the structure of a legged 
mobile robot of an embodiment showing its degrees of freedom. 

The robot shown in Fig. 1 has four limbs, the left and 
right arms and the left and right legs, mounted to a main 
25 body. Each of the left and right arms has seven degrees of 
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freedom provided in correspondence with a shoulder joint 
pitch axis, a shoulder joint roll axis, an upper arm yaw 
axis, an elbow joint pitch axis, a forearm yaw axis, a wrist 
roll axis, and a wrist pitch axis. Each of the left and 
5 right legs has six degrees of freedom provided in 

correspondence with a hip joint yaw axis, a hip joint roll 
axis, a hip joint pitch axis, a knee pitch axis, an ankle 
pitch axis, and an ankle roll axis. A pelvis Bl joining the 
left and right hip joints corresponds to a main body link. 

10 The upper part of the body is connected to the main body 

link Bl through waist joints having three degrees of freedom 
(roll, pitch, and yaw) , and the upper part of the body and 
the legs each having six degrees of freedom are joined to 
the main body link Bl . 

15 The degree of freedom of each joint is actually 

realized by an actuator /motor . In the embodiment, small AC 
servo actuators which are directly connected to gears and 
which incorporate in a motor unit a servo control system 
formed into a one-chip system. An AC servo actuator of this 

20 type is disclosed in, for example, Japanese Unexamined 

Patent Application Publication No. 2000-299970 (Japanese 
Patent Application No. 11-33386) which has already been 
assigned to the applicant. 

An acceleration sensor Al and a gyro Gl are mounted to 

25 the pelvis of the robot body. Uniaxial load cells (Fl to 
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F8) and infrared distance measuring sensors (Dl to D8) are 
mounted such that four of the load cells and four of the 
sensors are mounted to four corners of the left sole and the 
remaining four load cells and the remaining four sensors are 
5 mounted to the . four corners of the right sole. Acceleration 
sensors (A2 and A3) and gyros (G2 and G3) are mounted to the 
centers of the left and right soles, respectively. 

Here, the mass of the robot is represented by m, the 
position of the center-of-gravity in an inertial coordinate 
10 system is represented by x = (x, y, z) T , and an external 
force and an external moment exerted upon the robot are 
represented by F and N, respectively. 

Creating a robot motion pattern at random does not 
cause the robot to move as planned. It can move as planned 
15 only when a force f = (f x , f y , fz) T and a moment n = (n x , n y , 
n z ) T which a motion pattern is trying to provide are set to 
provide reaction against the actual environment. In other 
words, it is necessary to impose constraints on the force f 
and the moment n that the motion pattern is trying to 
20 produce so that F = f and N = n (see Fig. 2) . 

In the specification, such constraints concerning 
dynamic equilibrium are called "dynamic constraints." On 
the other hand, conditions for manifestly imposing 
positional and temporal constraints, such as on the feet end 
25 trajectories, are called "geometrical constraints." 
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As mentioned above, it is known that the dynamic 
constraint when the robot is in contact with a plane surface 
is equivalent to "a ZMP existing within a contact polygon." 
In other words, when any point p = (p x , p y , p z ) T exists 
5 within the contact polygon in an inertial coordinate system, 
and a moment generated around the point p is M = (M x , M y , 
M Z ) T , the dynamic constraint is provided by the following 
formula: 

M x = M y - 0 (i) 

10 As described later, the dynamic constraint represented 

by the equation above can be converted to one using the 
force f and the moment n that a motion pattern is trying to 
generate . 

On the other hand, when the robot is not in contact 
15 with the plane surface, since no external force or external 
moment is provided from the environment, dynamic constraints 
are provided by the following formulas: 
f = 0 (2) 

n = 0 (3) 

20 In the embodiment, by setting algorithms for 

calculating a motion pattern of the whole body in real time 
so that Formula (1) is established for a floor contact 
period and Formulas (2) and (3) are established for a floor 
non-contact period, a control system which can allow the 
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legged mobile robot to walk, run, hop, and jump freely is 
realized. Hereunder, in the specification, an example in 
which the position of the center of gravity of the robot is 
manipulated in order to satisfy Formulas (1) and (2) and in 
5 which the orientation of the main body (pelvis) of the robot 
is manipulated in order to satisfy Formula (3) will be 
described. 

Fig. 3 is a schematic view of a functions structure of 
the legged mobile robot of the embodiment of the present 

10 invention. As shown in the figure, the control system 

comprises a motion request input unit 3A, a real-time whole- 
body motion generating unit 3B, and a whole-body joint 
driving unit 3C. The real-time whole-body motion generating 
unit 3B comprises a sole position/orientation trajectory 

15 generating unit 31, a center-of -gravity position trajectory 
generating unit 32, a main body orientation trajectory 
generating unit 33, trajectory interpolation units (more 
specifically, an upper-body joint angle reference trajectory 
interpolation unit 34, a main body orientation reference 

20 trajectory interpolation unit 35, a center-of-gravity 

position reference trajectory interpolation unit 36, and a 
sole position/orientation reference trajectory interpolation 
unit 37), a mass point distribution adjusting unit 38, and a 
joint angle calculating unit 39. 

25 A motion request regarding the upper body (arm 
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joints/waist joints) (upper-body joint angle reference 
trajectory) , a motion request regarding an orientation angle 
of the main body (pelvis) (main body orientation basic 
trajectory) , a motion request regarding a center-of-gravity 
5 vertical position trajectory (center-of -gravity vertical 
position basic trajectory), and crural motion parameters, 
such as footstep, motion period, angle of traverse, and time 
at which robot apparatus is the legs are lifted from a floor, 
are input by the motion request input unit 3A and output to 

10 the real-time whole body motion generating unit 3B. These 
requests and parameters are constantly determined by a user 
program (or other means that is not shown) . 

The real-time whole-body motion generating unit 3B can 
smoothly change a present motion state to another motion 

15 state while dynamically maintaining balance based on the 

dynamic constraints, determines the robot motion state of a 
next time capable of satisfying requests for changing the 
upper-body and crural motions from the user program, and 
outputs the determined motion state as joint angle reference 

20 values of the whole body- 
In order to achieve the joint angle reference values 
output from the real-time whole-body motion generating unit 
3B, the whole-body joint driving unit 3C operates so that 
the actuator motors defining the degrees of freedom of the 

25 joints of the whole body are driven by a servo controller 
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(not shown) . 

Based on the crural motion parameters input by the 
motion request input unit 3A, the sole position/orientation 
trajectory generating unit 31 in the real-time whole-body 
5 motion generating unit 3B calculates the 

position/orientation trajectories of the left and right 
soles for a few steps ahead from the current positions and 
orientations of the soles. 

The center-of-gravity position trajectory generating 

10 unit 32 calculates a center-of-gravity position trajectory 
which, while maximally reflecting the center-of-gravity 
vertical position basic trajectory input by the motion 
request input unit 3A, smoothly connects to a current 
center-of-gravity position trajectory and which is such as 

15 to satisfy the aforementioned Formula (1) representing a 
dynamic constraint for a floor contact period and the 
aforementioned Formula (2) representing a dynamic constraint 
for a floor non-contact period. 

The main body orientation trajectory generating unit 33 

20 calculates a main body orientation angular trajectory which, 
while maximally reflecting the main body orientation basic 
trajectory input by the motion request unit 3A, smoothly 
connects to a current main body orientation trajectory and 
which is such as to satisfy the aforementioned Formula (3) 

25 representing a dynamic constraint for a floor non-contact 
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period in addition to the aforementioned Formulas (1) and 
(2) representing dynamic constraints for the aforementioned 
center-of-gravity position trajectory in the floor contact 
and floor non-contact periods. 
5 The trajectory interpolation units (the upper-body 

joint angle reference trajectory interpolation unit 34, the 
main body orientation reference trajectory interpolation 
unit 35, the center-of-gravity position reference trajectory 
interpolation unit 36, and the sole position/orientation 

10 reference trajectory interpolation unit 37) perform 

interpolation on the calculated upper-body joint angle 
reference trajectory, main body orientation reference 
trajectory, center-of-gravity position reference trajectory, 
and sole position/orientation reference trajectories, 

15 respectively. The mass point distribution adjusting unit 38 
which calculates the upper-body joint angles, the main body 
orientation angle, the position of the center of gravity, 
the sole positions and orientations of a next time adjusts 
the mass point distribution of the whole body so as to 

20 achieve at the same time the upper-body joint angles, the 
main body orientation angle, the position of the center of 
gravity, and the sole positions and orientations. 

The joint angle calculating unit 39 determines the 
joint angles of the legs so as to achieve the main body 

25 position of the next time obtained from the mass point 
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distribution adjusting unit 38 and the sole positions and 
orientations of the next time obtained from the sole 
position/orientation trajectory generating unit 31. The 
determination may be executed by, for example, performing a 
5 known reverse kinematic calculation after determining the 
relative positions and orientations of the legs. 

Fig. 4 is a flowchart of the steps executed by the 
control system shown in Fig. 3. 

When the control system starts operating, a motion 

10 request regarding the upper-body joint angles, a motion 
request regarding the main body orientation, a motion 
request regarding the position of the center-of -gravity 
vertical, and a crural motion request are input by the 
motion request input unit 3A (Step SI) . 

15 Then, the sole position/orientation trajectory 

generating unit 31, the center-of-gravity position 
trajectory generating unit 32, the main body orientation 
trajectory generating unit 33 generate sole 
position/orientation tra j ectories, a center-of -gravity 

20 position trajectory, and a main body orientation trajectory, 
respectively (Steps S2, S3, and S4) . 

Next, the trajectory interpolation units (the upper- 
body joint angle reference trajectory interpolation unit 34, 
the main body orientation reference trajectory interpolation 

25 unit 35, the center-of-gravity position reference trajectory 
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interpolation unit 36, and the sole position/orientation 
reference trajectory interpolation unit 37) perform 
interpolation on the upper-body joint angles, the main body 
orientation angle, the position of the center of gravity, 
5 and the positions and orientations of the soles of a next 
time, respectively (Step S5). 

Next, the mass point distribution adjusting unit 38 
calculates the joint angles of the whole body (Step S6) . 
Finally, the whole-body joint driving unit 3C drives each 

10 joint by a servo controller (Step S7). 

The above-described steps are carried out in one period 
of the control system shown in Fig. 3. The control system 
executes Step 1 again each time a predetermined control time 
t (for example, every 10 milliseconds) elapses from the time 

15 of completion of the above-described steps. 

Next, the functions structure and the operation of the 
real-time whole body motion generating unit 3B will be 
described in more detail. 

The sole position/orientation trajectory generating 

20 unit 31 in the real-time whole-body-motion generating unit 
3B determines the position orientation trajectories of the 
left and right soles for a few steps ahead from current sole 
positions and orientation states in accordance with crural 
motion parameters input by the motion request input unit 3A, 

25 such as footstep, motion period (walking period, running 
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period, hopping period, etc.), angle of traverse, leg 
lifting heights, and time at which the legs are lifted from 
a floor. 

Fig. 5 shows examples of sole position/orientation 
5 trajectories. As shown in Fig. 5, in the sole position 
orientation trajectories, the positions of the soles are 
defined by coordinate positions (x, y, and z) , and the 
orientations are defined by, for example, Euler angles (a, P, 
and y) . The sole position orientation trajectories formed 

10 by generating a time series by performing, for example, 

polynomial interpolations for respective parameters for the 
left and right soles so that the aforementioned crural 
motion parameters are satisfied. 

For example, if a left sole position orientation is 

15 represented by (x L , Yli- and z L , oc L , p L , Yl) / and a current 

left sole position orientation is represented by (x Li , y Li , 
Zli, ot L1 , pLif Yli) / a next floor contact start 
position/orientation (x L 2r yL2/ Zl2, a L2 , Pl2, Yl2) is 
determined by the crural motion parameters such as footstep, 

20 motion period, and angle of traverse; and left sole position 
orientation trajectories therebetween are defined by the 
following interpolation formulas used for the respective 
positions and orientations: 



4 



i 
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= y L (t;yu,y L2 ) 

Z L = Z l(?> Z L1> Z L2 ) 

a L = a L (t;a L1 ,a L2 ) (4) 

Yl ~ Yl&Yli'Yli) 

For example, polynomials of degree 5 may be used for 
the interpolation formulas. The sole positions and 
orientations of the second step and onwards are assumed as 
5 being continuations of the same crural motion requests of 
the first step, and are, thus, defined by similar 
interpolation formulas. The right sole position/orientation 
trajectory is similarly defined. 

The center-of-gravity position trajectory generating 
10 unit 32 calculates a center-of-gravity horizontal trajectory 
so that the dynamic constraint represented by the 
aforementioned Formula (1) is satisfied in a floor contact 
period and the dynamic constraint represented by the 
aforementioned Formula (2) is satisfied in a floor non- 
15 contact period. Hereunder, the center-of-gravity position 
trajectory generating unit 32 will be described in terms of 
specific methods of forming constraint formulas for a floor 
contact period and a floor non-contact period and a method 
for calculating a center-of-gravity position trajectory 
20 which satisfy both constraint formulas. 
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In the floor contact period, any point p = (p x , p y , and 
p z ) T exists in an inertial coordinate system, and the moment 
M is generated around this point p. The gravitational 
acceleration vector is expressed as -g = (0, 0, -g) T - From 
5 the equilibrium condition regarding the moment around the 
. point p, the following formula is established: 

M = n + (x-p)xf (5) 

From a center-of -gravity translational motion formula, 
the following formula is established: 
10 mX = f~mg (6) 

If the force f applied to the coordinate position x (x, 
y, and z) in each of the Formulas (5) and (6) is eliminated, 
the following formula is established: 

M = (x-p)x m(x + g) + n ( 7) 

15 Here, if the point p is ZMP, the horizontal axis moment 

becomes zero, so that the following formula is established: 
0~ 

= (x-p)xm(x + g) + n (8) 



In general, the moment generated around the ZMP is 
predominantly due to the motion of the center of gravity. 
20 Therefore, if the second right term in Formula (8) above is 
eliminated, and the first and the second terms are expanded, 
the following ZMP formula regarding the center-of -gravity 
motion is established: 
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(z-p z )x-(x-p x )(z + g) = 0 

(z-p z )y-(y-p t )(* + g) = o (9) 

Although Formula (9) above is simple, it is a 
differential equation of variable coefficients of x and y. 
Therefore, it cannot be easily solved- Consequently, in the 
5 embodiment, the following approximations are assumed to be 
true for a relatively short time interval T: 

(Assumption 1) There is no acceleration in a ZMP trajectory. 
(Assumption 2) The center-of -gravity height is constant. 
(Assumption 3) The external moment is constant. 
10 If these assumptions are true, the ZMP Formula (9) 

becomes the following simple normal differential equation: 
m(ZX-gX) = 0 (10) 

Formula (10) above is only for the x component, with 

the following formulas being satisfied. 
15 X = X- p x (11) 

Z = z - p z = const ( 12 ) 

The general solutions to the normal differential 
Formula (10) are as follows: 

x = p x + C x exp(vfa) + C 2 exp(-/U) 

* = P x + A{C X exp(At) - C 2 exp(-^)} ( 13 ] 

20 However, A, is a proper value expressed as follows: 



A = Jg7z (14) 

If boundary values of Formula (13) above are considered, 
the following holds true: 
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x(0) = Px (0) + C l +C 2 

^(0) = P JC (0) + A(C 1 -C 2 ) 

x(T) = p x (T) + C x exp(^r) + C 2 exp(-^r) 

i(r) = p x (T) + A{C X exp(Ar) - C 2 exp(-Ar)} 



(15) 



In the embodiment , the general motion of the legged 
mobile robot having a plurality of consecutive short 
intervals satisfying the aforementioned Assumptions 1 to 3 
5 is used as a model. Fig. 6 shows a state in which short 
intervals are consecutively set for N intervals. 

When the time width of an ith interval i is represented 
by Ti, undetermined coefficients are represented by Cu and 
C2i, the proper value is represented by X±, the ZMP position 
10 at a termination end of the interval i is represented by p x ±, 
and the center-of -gravity position is represented by xi, 
Formula (15) above providing the above-described boundary 
conditions is expressed as follows in a general interval i: 



contact period, since a horizontal external force is not 
exerted, the motion at a center-of -gravity horizontal 
position (x and y) is predominantly determined by the 
following simple motion formula. For simplicity, only the 



X i-\ ~" Pxi-\ + Qi + C 2 i 

*, = P« + c u exp(^r # ) + C 2 , exp(- ) 
*, = P« + *i fc, <*p( V) ) - C 2/ exp(-/l f j; )} 



(16) 



15 



In contrast, for a short interval in a floor non- 
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formula for the x direction is given. 

rnx = 0 (17) 

Integrating Formula (17) results in the following: 
X = C l +C 2 t (18) 
5 Here, when boundary conditions are considered, the 

following results : 

x(0) = C 1 

x(0) = c 2 

x(T) = C 1 +C 2 T < 19 > 
x(T) = C 2 

Although the model in which short intervals are set 
consecutively for N intervals in floor contact periods has 
10 used, short intervals may be set consecutively in floor 

contact periods and floor non-contact periods as shown in 
Fig. 7. 

When a short interval i exists in a floor non-contact 
period, its boundary conditions differ from those in the 
15 floor contact period. Based on Formula (19), the following 
results: 

Xi =C li+ C 2i T (20) 
x i = C 2i 

For a motion having a floor contact period and a floor 
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non-contact period, the undetermined coefficients must be 
determined so that these boundary conditions are such that 
the positions and speeds are connected. The conditions of 
continuity for the positions and speeds at the boundaries of 
5 an interval i-1 and the interval i depend upon the types of 
adjacent short intervals: 

(1) When the interval i-1 is in the floor contact period and 
the interval i is in the floor non-contact period, from 
Formula (16) above, the conditions for making x± and the 

10 speed component dxi/dt as seen from the interval i-1 equal 
to those as seen from the interval i are as follows: 

C u +C 2i =C u . 1 exp(X i _ l T i .0 + C 2i _ l exp(-A i _ l T i _ l ) (2 i, 

P *~ Pxt - 1 +A t (Cu-C 2t ) 

= p *- l ~ P *- 2 + {C xi _, expCA,..^ ) - C w expC-^TU )} ( 22 } 

(2) When the interval i-1 is in the floor non-contact period 
15 and the interval i is in the floor contact period, from 

Formulas (16) and (20) above, the conditions for making x ± 
and the speed component dxi/dt as seen from the interval i-1 
equal to those as seen from the interval i are as follows: 



P*i-\ + C u + C n = C u-i + (23) 
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Pxi Pxx-\ + X.(C U - C 2l ) = C 2M (24 ) 

^ i 

(3) When the interval i-1 is in the floor contact period and 
the interval i is in the floor non-contact period, from 
Formulas (16) and (20) above, the conditions for making Xi 

5 and the speed component dxi/dt as seen from the interval i-1 
equal to those as seen from the interval i are as follows: 

Cu = Pxi-i + Qm expC^-i^-i ) + c u-\ expC-A,..,^., ) (25) 

C 2i = P3a - 1 ~ P "- 2 + 4-, {C 1M exp^T^ ) - C w expC-^^ )} {26) 

(4) When the interval i-1 is in the floor non-contact period 
10 and the interval i is in the floor non-contact period, from 

Formula (20) above, the conditions for making x± and the 
speed component dxi/dt as seen from the interval i-1 equal 
to those as seen from the interval i are as follows: 

Qi = Qf-i + Qi-i^-i (27) 

15 C 2 | =C 2/-l (28) 

The conditions of continuity of the position and speed 
at the boundary of the short intervals above also hold at 
boundaries of short intervals i = 2 ... N. Boundary 
conditions for achieving the given center-of-gravity 

20 position and speed are also imposed even at the starting end 
of the entire motion interval. For a formula allowing a 
mixture of floor non-contact period intervals and floor 
contact period intervals, the boundary conditions that must 
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be met depend upon whether an interval 0 is in a floor non- 
contact period or a floor contact period as follows: 

(1) When the interval 0 is in the floor contact period, from 
Formula (16) above, the starting end of the interval 0 is 

5 such that the following formulas are satisfied: 
C h +C 2i +P*o = *o (29) 

P x \ Pxo +A l (C h ~C 2i ) = x 0 (30) 
1 \ 

(2) When the interval 0 is in the floor non-contact period, 

from Formula (20) above, the starting end of the interval 0 

10 is such that the following formulas are satisfied: 
C l} = X 0 (31) 

C 2i =x 0 (32) 

Similarly, at a termination point of the interval N, 
boundary conditions for achieving the given center-of- 

15 gravity position and speed must be satisfied as a 

termination end condition of the whole motion period. The 
boundary conditions that must be satisfied depend upon 
whether or not the interval N is in the floor non-contact 
period or the floor contact period as follows: 

20 (1) When the interval N is in the floor contact period, from 

Formula (16) above, the termination end of the interval N is 

such that the following formulas are satisfied: 
p XN + C 1n exp(^r^ ) + C 2n ex$(-A, N T N ) = x N ( 3 3 ) 
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Pxn ~ Pxn " + {c iN exp(^r„ ) - C 2n cxp(-Z N T N )} = 5c N {34) 

N 

(2) When the interval N is in the floor contact period, from 
Formula (20) above, the termination end of the interval N is 
such that the following formulas are satisfied: 
5 Q N +CiT N = X N (35) 
C 2n =x n (36) 

The position and speed of the center of gravity based 
on the conditions for the starting end are replaced by a 
current position and a current speed of the center of 

10 gravity in order to obtain a center-of -gravity position 

trajectory that smoothly connects to a current motion state. 
For the center-of -gravity position based on the conditions 
for the termination end, the central positions of both soles, 
etc., are set based on the positions of both soles at the 

15 motion termination end. Assuming that the center of gravity 
is stopped at the center-of-gravity position, for example, 
zero is set for the speed of the center of gravity at the 
termination end. This imposes a constraint on the solutions 
of the motion equation so that, after the passage of a 

20 certain time period, the center of gravity comes directly 
above the centers of both soles. 

In generating a real-time motion pattern, since re- 
planning of generating a motion pattern is repeated at a 
relatively short period of time (for example, each time a 
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control period elapses) , it is sufficient to achieve a 
stable motion state within a very short period of time until 
the next re-planning. Therefore, it is possible to obtain 
solutions of sufficient practical precision even if the 
5 conditions for reaching the termination end that is 
sufficiently separated from the current time are only 
approximations as described above. 

The boundary of short intervals is set as, for example, 
the boundary of a period in which the robot is supported by 

10 both legs and a period in which the robot is supported by 
one leg, or the boundary of a floor contact period and a 
floor non-contact period. 

Formulas (21) to (36) above imposes 2N + 2 constraints 
at the boundaries of the N short intervals that are 

15 successively set. There are various methods of setting 

variables other than the undetermined coefficients Ci± and 
C 2 i (i = 1 ... N) . In the embodiment, p xi (i = 1 ... N) are 
added as a variable. If at least one floor contact period 
exists, there are at least two ZMP positions p xi , so that the 

20 number of variables is 2N + 2, thereby making it possible to 
obtain solutions. 

In general, there are at least two floor contact period 
intervals among the successively set intervals. Therefore, 
there are too many variables. Consequently, optimization is 

25 carried out. For example, when a secondary plan problem 
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with an equality constraint for minimizing the difference 
(see -formula below) between the ZMP position p xi at the 
boundary of a floor contact period and a stable area center 
(center of gravity at polygon in the floor contact period) 
under the equality constraints given by Formulas (21) to 
(36) is solved, these undetermined variables can be uniquely 
set . 



Alternatively, Formulas (21) to (36) above may be 
solved as simultaneous linear equations in 2N + 2 unknowns, 
with the ZMP positions other than two particular nodes p X j 
and Pxk {jr k e [o, N] ) at the boundary of the floor contact 
period being fixed and only p X j and p xk being set as 
variables. If the undetermined variables are determined, 
the center-of -gravity horizontal position at any time in the 
planned motion period can be calculated using Formula (13) 
above for the floor contact period and Formula (18) for the 
floor non-contact period. 

This means that a center-of -gravity horizontal position 
trajectory is obtained by the above. A center-of -gravity 
vertical position trajectory must be generated so as to meet 
a dynamic constraint. As long as f 2 > 0 in a floor contact 
period, the center-of-gravity vertical motion is not 
particularly dynamically constrained. In contrast, it is 
dynamically constrained when f z = 0 in a floor non-contact 



min 




(37) 
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period. More specif ically, when f 2 = 0 in Formula (6) above, 
the Z component is obtained by: 

mz = -mg OS) 

When Formula (38) above is integrated, it becomes: 
1 2 

5 z = --gt +K x t + K 2 (39) 

When the time at which the legs of the robot are lifted 
from the floor is T, and the undetermined coefficients are 
set as a center-of -gravity vertical position Zi at a floor 
non-contact start time and a center-of -gravity vertical 
10 position z 2 at a floor contact start time, the center-of- 
gravity vertical position trajectory of the robot is 
obtained as a free fall curve defined by the following 
formulas: 



z = --gt 2 + f ^— ^ + lgr\ + z, 



2 



J 



l (40) 



15 i = - g/+ J^_£ L+ I g rJ (41) 

For the center-of -gravity vertical position z x at the 
floor non-contact start time and the center-of -gravity 
vertical position Z2 at the floor contact start time, values 
of a center-of-gravity vertical position basic trajectory at 
20 the starting end and the termination end of the floor non- 
contact period input from the motion request input unit 3A 
are used. 
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Here, the center-of-gravity vertical position 
trajectory input by the user program is called "basic 
trajectory" because the final center-of-gravity vertical 
position reference trajectory is different due to 
5 corrections made to satisfy the aforementioned dynamic 
constraints. In other words, the basic trajectory is a 
general trajectory previously set by a user. Hereunder, in 
the specification, the term "basic trajectory" means a 
trajectory which is maximally reflected, but is to be 

10 corrected to satisfy the dynamic constraints. 

The center-of-gravity vertical position trajectory is 
set at each floor non-contact period by Formula (40) above. 
If the dynamic constraints are not particularly imposed upon 
the center-of-gravity vertical position trajectory at a 

15 floor contact period, but the floor contact period is 
adjacent to a floor non-contact period, the center-of- 
gravity position basic trajectory in the floor contact 
period must be corrected so as to smoothly connect to the 
center-of-gravity vertical position trajectory obtained by 

20 Formula (40) at the boundary of the floor non-contact period 
and the floor contact period. In other words, the center- 
of-gravity vertical motion state at the non-contact start 
time has the following value with t = 0 in Formulas (40) and 
(41) . 
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z = z x ,z = Zj = 



f ' z -z 1 ^ 



(42) 



V r 2 , 

Therefore, for a smooth connection, the center-of- 
gravity vertical position basic trajectory in the floor 
contact period immediately preceding the floor non-contact 
5 period must be corrected. The floor contact period 

including the interval i-1 in Fig. 8 corresponds to such a 
case . 

The interval i-1 shown in Fig. 8 is disposed between 
floor non-contact periods. A curved trajectory which 

10 satisfies the boundary condition of Formula (42) above must 
be set at the boundary of the interval i-1 and an interval 
i-2 (starting end) in addition to the boundary of the 
interval i-1 and the interval i (termination end) . 

The center-of-gravity vertical position trajectory 

15 between floor contact periods can be set as a curved 

trajectory so as to satisfy the starting end and termination 
end conditions by, for example, polynomial interpolation. 
Alternatively, if necessary, a curve may be formed so that a 
minimum value is not reduced from the basic trajectory by an 

20 amount greater than a center-of-gravity sinking depth Az for 
the floor contact start time/non-contact start time included 
as a crural motion parameter; interpolation may be performed 
using a special curve not including an inflection point; or 
a spring/damper system response curve may be used. 



Similarly, the center-of-gravity vertical motion state 
at the contact start time has the following value with t = 0 
in Formulas (40) and (41) . 



Therefore, for a smooth connection, the center-of- 
gravity vertical position basic trajectory in a floor 
contact period immediately following a floor non-contact 
period must be corrected. The interval i + 1 in Fig. 8 
corresponds to such a case. 

Unlike the interval i - 1, an end of the interval i + 1 
in Fig. 8 is connected to a floor contact period interval i 
+ 2. In this case, the center-of-gravity vertical position 
trajectory of the interval i is set so that the boundary of 
the interval i + 1 and the interval i (starting end) 
satisfies the boundary condition of Formula (43) above and 
the boundary of the interval i + 1 and the interval i + 2 
(termination end) is such that the position and speed are 
continuous with the position and the speed of the center-of- 
gravity vertical position basic trajectory. 

As in the case in which a floor contact period directly 
precedes a floor non-contact period, a curved trajectory may 
be set so as to satisfy such starting end and termination 
end conditions by, for example, polynomial interpolation. 
Alternatively, if necessary, a curve may be formed so that a 



Z — Z 2 ,Z — Z 2 ~~ 



{ T 2 




) 



(43) 



- 44 - 



minimum value is not reduced from the basic trajectory by an 
amount greater than a center-of -gravity sinking depth Az for 
the floor contact start time/non-contact start time included 
as a crural motion parameter; interpolation may be performed 
5 using a special curve not including an inflection point 

while eliminating accidental vibration; or a spring/damper 
system response curve may be used. 

For a center-of-gravity vertical position trajectory in 
a floor contact period that is not adjacent to a floor non- 
10 contact period, the center-of-gravity vertical position 
basic trajectory is used as a reference trajectory. 
Similarly, for a center-of-gravity vertical position 
trajectory in a floor contact period which is adjacent to a 
floor non-contact period, the entire trajectory in the 
15 entire floor contact period does not necessarily have to be 
a correction of the basic trajectory. In such a case, the 
trajectory may be partly corrected, for example, immediately 
before or after the floor non-contact start time or the 
floor contact start time. 
20 In this way, the center-of-gravity position trajectory 

generating unit 32 generates a center-of-gravity position 
trajectory so as to satisfy Formula (1) providing a dynamic 
constraint in a floor contact period and Formula (2) 
providing a dynamic constraint in a floor non-contact period. 
25 Fig. 9 is a flowchart of the steps executed by the center- 
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of-gravity position trajectory generating unit 32. 

First, in a ZMP basic node generation, the arrangement 
of basic ZMP positions at the boundaries of the short 
intervals is generated so that a ZMP trajectory passes near 
5 the center of the stable area (the center of gravity of the 
contact polygon) based on the sole position and orientation 
reference trajectories produced by the sole 
position/orientation trajectory generating unit 31 (Step 
Sll) . 

10 Each basic ZMP position is corrected in the next step 

of calculating a next center-of -gravity horizontal position 
trajectory (Step S14), but is reflected so as to be 
maximally achieved. Here, if a basic ZMP trajectory which 
passes outside the floor-contact polygon or which greatly 

15 deviates from the center of the stable area is set, when the 
basic ZMP positions are corrected in the step of calculating 
a next center-of -gravity horizontal position trajectory 
(Step S14), the ZMPs may be outside the contact polygon, as 
a result of which the. dynamic constraints may not be 

20 satisfied. Such a case does not occur frequently. However, 
if a better system is to be achieved, when a ZMP trajectory 
which lies outside the contact polygon is obtained, 
additional operations, such as autonomously correcting the 
basic ZMP positions or autonomously changing a crural motion 

25 parameter, may be carried out. 
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Next, a step of setting conditions for continuity of a 
center-of-gravity position trajectory at the boundaries of 
short intervals are set (Step S12) . More specif ically, 
based on Formulas (21) to (28) above, the equality 
5 constraints are set in a matrix. As mentioned above, the 
continuity condition constraint equations depend upon 
whether adjacent intervals are those of floor contact 
periods or floor non-contact periods . 

Next, center-of-gravity horizontal position trajectory 

10 boundary conditions at the starting end and termination end 
of a motion interval under consideration are set in a matrix 
(Step S13) . The starting end boundary conditions are 
provided by Formulas (29) to (32) above and the termination 
end boundary conditions are provided by Formulas (33) to 

15 (36) above. Like the conditions of continuity at the short 
interval boundaries, the constraint equations depend upon 
whether or not the interval 0 and the interval N are in the 
floor contact period or the floor non-contact period. 
Next, the secondary plan problem with equality 

20 constraints set in Steps S12 and S13 (Formula 37) is solved, 
and the undetermined coefficients Cu and C 2 ± (i = 1 ... N) and 
the ZMP positions p x ± (i = 1 ... N) are determined. 

By such operations, the center-of-gravity horizontal 
position and speed at any time using Formula (18) above for 

25 a floor non-contact period and using Formula (13) above for 
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a floor contact period can be calculated. In other words, 
the center-of-gravity horizontal position trajectory of any 
time is obtained. 

Next, a step of calculating a center-of-gravity 
5 vertical position trajectory at a floor non-contact period 
is carried out (Step S15) . More specifically, based on the 
center-of-gravity vertical position basic trajectory 
provided by the user program, coefficients of the quadratic 
equation represented by Formula (40) above) are determined. 

10 Such an operation makes it possible to calculate the 

position and speed of the center of gravity at any time in 
the floor non-contact period (including the boundaries) . 

Next, a step of calculating the vertical position and 
speed of the center of gravity at a boundary of short 

15 periods is carried out (Step S16) . The position and speed 
of the center of gravity at a boundary of a non-contact 
period are calculated using Formulas (42) and (43) above. 
For the position and speed of the center of gravity of 
boundaries other than this boundary, the values of the 

20 center-of-gravity vertical position basic trajectory 
provided by the user program may be used. 

Lastly, the center-of-gravity vertical position 
trajectory at a floor contact period is corrected, so that 
the formation of a center-of-gravity vertical position 

25 trajectory satisfying the dynamic constraints, that is, the 
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center-of-gravity position trajectory is completed (Step 
S17) . 

For a floor contact period adjacent to a floor non- 
contact period, a center-of-gravity vertical position 
5 trajectory is formed by a proper curve using, for example, a 
polynomial formula so as to satisfy the boundary conditions 
calculated in Step S16. For a floor contact period which is 
not adjacent to a floor non-contact period, the center-of- 
gravity vertical position basic trajectory provided by the 

10 user program is used as the center-of-gravity vertical 
position trajectory. 

As a result of the above-described operations, by Step 
S15, the center-of-gravity vertical position trajectory of 
the floor non-contact period is obtained, and by Step S17 

15 the center-of-gravity vertical position trajectory at the 

floor contact period is obtained. Therefore, the center-of- 
gravity vertical position trajectories of all times are 
obtained. 

As can be understood from the foregoing description, a 
20 center-of-gravity position trajectory which satisfies the 
dynamic constraint represented by Formula (1) or (2) is 
obtained. The remaining dynamic constraint represented by 
Formula (3) for the floor non-contact period must be 
separately reflected in regard to the motion plan. 
25 In general, an angular momentum L and an external 
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moment n around the center of gravity have the following 
relationship : 




In the floor non-contact period, the dynamic constraint 
5 represented by Formula (3) must be satisfied. By 

substituting this into Formula (44) above and integrating it, 
it can be understood that the resulting formula is 
equivalent to the law of conservation of angular momentum. 

L = const = L (45) 

10 In addition to the constraints regarding the sole 

position/orientation trajectories output from the sole 
position/orientation trajectory generating unit 31 and 
regarding the center-of -gravity position trajectory output 
from the center-of-gravity position trajectory generating 

15 unit 32, the motion in the floor non-contact period must be 
planned so as to satisfy the constraint regarding the 
angular momentum represented by Formula (45) above. 
Hereunder, a method of planning the motion of the robot 
apparatus so as to satisfy the constraint regarding angular 

20 momentum will be described in detail. 

In general, the state of the robot may be represented 
by the position and the orientation of the main body 
(pelvis) and the angles of all the joints. More 
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specif ically, if the position of the main body is 
represented by p b = (Pbx, Pby, Pbz)T, the orientation of the 
main body (Eulerian angle) is represented by a b = * (a bx , a by , 
a b2 ) T f the left foot joint angles are represented by 9 L = (0 L i, 
5 9 L2 , 9 L3 , 9 L4 , 9 L5 , 9 L6 ) T , the right foot joint angles are 
represented by 0 R = (9 R1 , 9^, 9 R3 , 9 R4 , 9 R5 , 9 R6 ) T , and the 
upper-body joint angles are represented by 9 a = (9 1D , 9 NU ) , 
a robot state variable q can be defined as a vector 
represented by the following formula in which all these 
10 values are arranged. Here, the order of the robot state 
variable q is N q . 



Indices are provided to all of the links, and the link 
having an index number i is link i. The relationships among 

15 the generalized velocities of the robot state variable q, 

the angular speed and the translational speed of the link i, 
the center-of -gravity speed of the entire robot, and the 
angular momentum around the center of gravity are 
represented using Jacobian J as in Formulas (47), (48), (49), 

20 and (50) : 



Pb 




(46) 



(47) 



- 51 - 



Pi=J p £ (48) 
X = J x q (49) 

L = J L q (50) 

Here, each Jacobian J represents a 3 x N q matrix, and, 
5 in general, can be analytically obtained as a function of 

the current robot state q. If the current state q is known, 
using these formulas, the constraints concerning the center- 
of-gravity position trajectory, the sole 

position/orientation trajectories, and the angular momentum 
10 can be represented as follows as constraints regarding the 

generalized velocities of the robot state. A left sole link 
index is i L , and a right sole link index is i R . 

(1) Constraints regarding sole orientations 

Since, in Formula (47) above, the angular speeds of the 
15 sole links must be equal to the Eulerian speeds of the left 
and right feet calculated from the sole trajectories 
generated by the sole position/orientation trajectory 
generating unit 31, 

d h =J a>J = \ < 51) 

(2) Constraints regarding the positions of the ends of the 
feet 

Since, in Formula (48), the translational speeds of the 
sole links must be equal to the translation speeds of the 
25 left and right feet calculated from the sole trajectories 
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generated by the sole position/orientation trajectory 



generating unit 31, 



(53) 



(54) 



(3) Constraint regarding the center-of -gravity position 

Since, in Formula (49), the speed must of the center of 
gravity must be equal to the speed of the center of gravity 
calculated from the center-of-gravity position trajectory 
generated by the center-of-gravity position trajectory 
generating unit 32, 



(4) Constraint regarding angular momentum 

If, in Formula (50) above, the angular momentum is 
constant, then 



Since each of these equations of constraint provides 
three degrees of freedom, a total of 18 degrees of freedom 
are provided by the constraints from Formulas (51) to (56) 
above. Here, if the position and orientation of the main 
body (pelvis) are used as manipulation elements, the leg 
joint angular speeds (total of 12 variables) , and the 
Eulerian angular speed (three variables) and the 
translational speed (3 variables) of the main body among the 
generalized velocities of the robot state q are unknown, and 
the upper-body joint angular trajectory is known. Therefore, 



x = J x q = x 



(55) 



L = J L q = L 



(56) 
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there are 18 unknowns, which match the number of equations 
of constraint. Consequently, it is possible to easily 
determine the unknown variables by solving Formulas (51) to 
(56) as simultaneous linear equations in 18 unknowns. 
5 Although the order of the simultaneous equations can be 

reduced by modifying these equations, such equations will 
not be described in the specification because that is not 
the main purpose of the present invention. 

As can be understood from the foregoing description, 

10 under the condition in which the current orientation is 

known and the positions and orientations of the soles and 
the position of the center of gravity are fixed, the 
Eulerian angular speed and the translational speed of the 
main body for conserving angular momentum are calculated. 

15 Therefore, a main body orientation oc b# k+1 at each control 
cycle (time At) can be determined by integrating the 
Eulerian angular speed obtained as a solution to the 
simultaneous equations and by solving- the following formula: 
a b*+i A ' (57) 

20 In the foregoing description, a main body orientation 

trajectory which satisfies Formula (3) , which is a dynamic 
constraint regarding the rotational motion in a floor non- 
contact period, in addition to the dynamic constraints 
represented by Formulas (1) and (2) above is obtained. 

25 However, if the angular momentum is not set to a proper 
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value, the robot may rotate considerably above the floor. 

There are various methods for setting angular momentum. 
If it is not assumed that the whole body of the robot 
rotates considerably above the floor, the easiest way to set 
5 the angular momentum in a floor non-contact period to zero 
is by using the following formula: 

L = 0 (58) 

Alternatively, it is practical to set the angular 
momentum by, for example, the following formula using a time 
10 T in which the legs of the robot are lifted from the floor, 
a traverse angle T, and an inertial moment I zz around the Z 
axis calculated at the non-contact start time so that 
angular momentum is only provided around a yaw axis. 
0 

(59) 



L = 



0 



L /jr/r 



15 The main body orientation trajectory in a floor non- 

contact period is obtained by carrying out the above- 
described steps. In contrast, the main body orientation 
trajectory in a floor contact period is obtained by 
correcting the main body orientation basic trajectory in the 

20 floor contact period such that it smoothly connects to the 
main body orientation trajectory in the floor non-contact 
period. 
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More specif ically, the main body orientation trajectory 
in the floor contact period directly preceding the floor 
non-contact area must be corrected so that, at the boundary 
between the floor contact area and the floor non-contact 
5 area, which corresponds to a floor non-contact start time, 
the main body orientation angle is equal to the value of the 
main body orientation angle basic trajectory and so that, in 
this orientation here, the main body orientation angular 
speed is equal to the angular speed of the main body 

10 orientation obtained by solving the Simultaneous Formulas 
(51) to (56) above. 

Similarly, the main body orientation trajectory in a 
floor contact period immediately following a floor non- 
contact period must be corrected so that, at the boundary 

15 between the floor non-contact period and the floor contact 

period, which corresponds to a floor contact start time, the 
main body orientation angle equals the main body orientation 
angle at the termination end of the non-contact period 
obtained by the numerical integration of Formula (57) above 

20 and so that, in the orientation here, the main body 
orientation angular speed is equal to the main body 
orientation angular speed obtained by solving the 
Simultaneous Equations (51) to (56) above. 

Fig. 10 shows the relationship between the main body 

25 orientation basic trajectory and a main body orientation 
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reference trajectory in the model in which short intervals 
and short intervals in floor non-contact periods exist. In 
the figure, an interval i-1 corresponds to such a case. For 
simplifying the figure, only a roll angle trajectory is 
5 illustrated. 

The starting end and termination end of the interval i- 
1 are joined to floor non-contact intervals. The 
aforementioned constraints are imposed not only at the 
boundary between an interval i and the interval i-1 

10 (termination end) , but also at the boundary between the 
interval i-1 and an interval i-2 (starting end) . For 
example, using polynomial interpolation, such as spline 
interpolation, the main body orientation trajectory in a 
contact period is set as a curved trajectory satisfying such 

15 starting end/termination end conditions. 

In contrast, unlike the interval i-1, an interval i + 1 
is in a floor contact period such that the starting end is 
adjacent to the floor non-contact period interval i and the 
termination end is joined to a floor contact period interval 

20 i+2. In this case, the main body orientation angular 
trajectory in the interval i must be set so that the 
boundary between the interval i+1 and the interval i 
(starting end) satisfies the boundary condition of the main 
body orientation angular trajectory in the floor non-contact 

25 period and so that the boundary between the interval i+1 and 
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the interval i+2 (termination end) is such that the position 
and speed are continuous with the position and speed of the 
main body orientation basic trajectory. Even in this case, 
for example, a curved trajectory may be set so as to satisfy 
5 such starting end/termination end conditions using, for 
example, polynomial interpolation . 

The main body orientation angular trajectory in a floor 
contact period that is not adjacent to a floor non-contact 
period is set using the main body orientation basic 
10 trajectory as a reference trajectory. The main body 

orientation angular trajectory in a floor contact period 
that is adjacent to a floor non-contact period may be formed 
by partly correcting the trajectory immediately before/after 
the floor non-contact start period or the floor contact 
15 start period instead of correcting the basic trajectory in 
the whole floor contact period as described above . 

The method for correcting the main body orientation 
angular trajectory in a floor contact period differs from 
the method for correcting the center-of -gravity position 
20 trajectory in that it must be successively carried out in 
terms of time. This is because the main body orientation 
angular trajectory in a floor non-contact period can only be 
obtained by numerical integration based on Formula (57), as 
a result of which the boundary condition at the floor non- 
25 contact termination end is determined by this numerical 
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integration. Actually , the numerical integration is only 
carried out during the floor non-contact period. Therefore, 
the trajectory in an adjacent floor contact period is 
corrected at the boundary of transition from the floor non- 
5 contact period to the floor contact period. 

Accordingly, the main body orientation trajectory 
generating unit 33 can generate a main body orientation 
trajectory which satisfies the dynamic constraint in a floor 
non-contact period represented by Formula (3) , in addition 

10 to Formula (1) representing a dynamic constraint in a floor 
contact period and Formula (2) representing a dynamic 
constraint in a floor non-contact period. 

Fig. 11 is a flowchart showing the steps executed by 
the main body orientation trajectory generating unit 33. 

15 First, a determination is made as to whether or not the 

current period is a floor non-contact period (Step S21). 

If the period is a floor non-contact period, the 
process proceeds to Step S22 in order to solve the Jacobian 
Constraint Formulas (51) to (54) regarding the current sole 

20 positions and orientations using the sole position and 
orientation trajectories output from the sole 
position/orientation trajectory generating unit 31. 

Next, using the center-of -gravity position trajectory 
output from the center-of -gravity position trajectory 

25 generating unit 32, the Jacobian Constraint Formula (55) 
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regarding the current position of the center of gravity is 
solved (Step S23) . 

Next, using the angular momentum calculated before the 
floor non-contact start time, the Jacobian Constraint 
5 Formula (56) regarding the angular momentum is solved (Step 
S24) . 

Next, the current main body orientation angular speed 
is calculated by solving the simultaneous linear equations 
comprising the Constraint Formulas (51) to (56) (Step S25) . 
10 Lastly, the main body orientation angular trajectory in 

the floor non-contact period is successively generated by 
numerically integrating the main body orientation angular 
speed using Formula (57) above (Step S26) . 

In contrast, if a determination is made that the period 
15 is a floor contact period in Step S21, a determination is 
made as to whether or not the current time corresponds to 
the starting end of the floor contact period (Step S20) . 

If the current time corresponds to the starting end of 
the floor contact period, the process proceeds to Step S27 
20 in order to determine whether or not the floor contact 
period is adjacent to a floor non-contact period. 

If the floor contact period is adjacent to a floor non- 
contact period, a determination is further made as to 
whether or not a short period immediately following the 
25 floor contact period is a floor non-contact period (Step 
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S28) . 

If the immediately following short period is a floor 
non-contact period, a target angular momentum of the floor 
non-contact period is calculated based on, for example, 
5 Formula (58) or (59) (Step S29) . 

Next, the Jacobian Constraint Formulas (51) to (54) 
regarding sole positions/orientations, the Jacobian 
Constraint Formula (55) regarding the position of the center 
of gravity, and the Jacobian Constraint Formula (56) 
10 regarding angular momentum are solved for the floor non- 
contact starting point (Steps S30, S31, and S32) . 

For solving these Jacobian constraint formulas, the 
sole position/orientation trajectories generated by the sole 
position/orientation trajectory generating unit 31 and the 
15 center-of -gravity position trajectory generated by the 

center-of-gravity position trajectory generating unit 32 at 
the floor non-contact start point are used in addition to 
the angular momentum obtained in the previous Step S2 9. 

Next, the main body orientation angular speed at the 
20 floor non-contact start time is calculated by solving the 
simultaneous linear equations comprising the Jacobian 
Constraint Formulas (51) to (56) (Step S33) . At this time, 
the boundary condition at the termination end of the floor 
contact period is determined. 
25 Next, a determination is made as to whether or not a 
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short interval directly preceding the floor contact period 
is a floor non-contact period (Step S34) . 

If the directly preceding short interval is a floor 
non-contact period, the setting of boundary conditions at 
5 both ends of the floor contact period is completed by using 
the main body orientation angular speed at the termination 
end of the floor non-contact period obtained by Step S26 as 
a boundary condition of the floor contact period starting 
end (Step S35) . 

10 In contrast, if it is determined that the directly 

preceding short interval is a floor contact period in Step 
S34, the setting of the boundary conditions of both ends of 
the floor contact period is completed by setting the value 
of .a main body orientation basic trajectory from the user 

15 program as a boundary condition of the floor contact period 
starting end (Step S38). 

If, in Step S28, the immediately following short period 
is also a floor contact period, the process proceeds to Step 
S37 in order to set the value of a main body orientation 

20 basic trajectory provided by the motion request input unit 
3A as a boundary condition of the floor contact period 
termination end. The boundary condition of the floor 
contact period starting end is determined by carrying out 
the same operations as those that are carried out when, in 

25 Step S28, a determination is made that the short interval 
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immediately following the floor contact period is a floor 
non-contact period. Accordingly, the setting of the 
boundary conditions of both ends of the floor contact period 
is completed. 

5 By the above-described operations, the boundary 

conditions of both ends of the floor contact period when the 
floor contact period is adjacent to a floor non-contact 
period are set. In Step S39, in order to satisfy the 
boundary conditions, a main body orientation trajectory in 

10 the floor contact period is formed using a curve by, for 
example, polynomial interpolation. 

■ When, in Step S27, a determination is made that the 
floor contact period is not adjacent to any floor non- 
contact period, the main body orientation basic trajectory 

15 from the motion request input unit 3A can be used for the. 

main body orientation trajectory in the floor contact period, 
so that, in Step 36, the main body orientation basic 
trajectory is set as the main body orientation trajectory in 
the floor contact period, thereby completing the operations. 

20 Returning to Fig. 3, the description of the functions 

structure of the control system of the robot of the 
embodiment will be continued. In the description up to now, 
the upper-body joint angle reference trajectory, the main 
body orientation reference trajectory, the center-of -gravity 

25 position reference trajectory, and the sole position 
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orientation reference trajectories from the user program are 
all obtained. By performing interpolation at each control 
period on these trajectories by the interpolation units (the 
upper-body joint angle reference trajectory interpolation 
5 unit 34 , the main body orientation reference trajectory 
interpolation unit 35, the center-of-gravity position 
reference trajectory interpolation unit 36, and the sole 
position/orientation reference trajectory interpolation unit 
37) disposed at the respective trajectories, the upper-body 

10 joint angles, the main body orientation angle, the position 
of the center of gravity, and the positions and orientations 
of the soles can be calculated. Since the main body 
orientation angle trajectory in a floor non-contact period 
is provided by numerical integration, interpolation by the 

15 main body orientation reference trajectory interpolation 
unit 35 is not particularly required. 

The mass point distribution adjusting unit 38 adjusts 
the mass point distribution of the whole body so as to set 
the main body orientation and the position of the center of 

20 gravity of a next time obtained above. More specifically, 
with the main body orientation, the positions and 
orientations of the soles, and the upper-body joint angles 
being fixed to desired values, the position (x B , y B , and z B ) 
of the main body (pelvis) is manipulated to adjust the mass 

25 point distribution of the whole body so that the center of 
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gravity of the whole body is at the position of the center 
of gravity obtained above; Under such a geometrical 
constraint, the speed of the main body and the speed of 
center of gravity have the following relationship when 
5 Jacobian J B is used. 



When a difference dx = x k +i - x k exists between a current 
center-of -gravity position Xk of the robot and a center-of- 
gravity position x k+ i of a next time obtained by solving the 
10 ZMP equation, an approximation of a manipulation amount dx B 
of the main body position can be obtained by the following 
formula : 



15 from- the user program is reflected in the calculation of the 

center of gravity. 

From the above, when a current main body position is x BK , 

a main body position x B k+i after adjusting the mass-point 

distribution for realizing the main body orientation and the 
20 center-of-gravity position of the next time obtained above 

is obtained by the following formula: 




(60) 



dx 



: B = J B 2 dx 



(61) 



Here, the upper-body joint angle reference value input 



x R =x B +J'Jdx 



(62) 



If the difference between the center-of-gravity 
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position and the reference center-of-gravity position 
obtained from Formula (62) above is still large, Formula 
(62) may be repeatedly used to perform convergence 
calculation until the difference is sufficiently small. 
5 The joint angle calculating unit 39 determines the 

joint angles of the legs so as to achieve the position of 
the center of gravity of the next time obtained from the 
mass point distribution adjusting unit 38 and the sole 
positions and orientations of the next time obtained from 

10 the sole position/orientation trajectory generating unit 31. 
This can be executed by, for example, a known reverse 
kinematic calculation after determining the relative 
positions and orientations of the legs. The leg joint 
angles obtained here and the upper-body reference joint 

15 angles obtained from the user program are output as whole- 
body joint angle reference values of the next time. 

By the control system of the robot shown in Fig. 3, 
when the legged mobile robot not only walks but also hops or 
jumps or runs or successively performs these motions, the 

20 robot can move by immediately (or in real time) calculating 
a dynamically stable motion pattern while satisfying 
external requests such as footstep and period. 

Although in the embodiment described in the 
specification the center-of-gravity position and the main 

25 body orientation angle are used as state quantities, other 
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state quantities may be used. For example, the position of 
a portion (such as the waist) near the center of gravity may 
be used instead of the position of the center of gravity or 
the hip joint angles may be used instead of the main body 
orientation angle. Even in such cases the same advantages 
of the present invention can be provided. Alternatively , 
any joint angle may be used as a state quantity to form what 
is called a whole-body cooperative control system. 

In the embodiment , the generation of the whole-body 
motion is executed every control period, but the present 
invention is not limited thereto. Trajectory generation may 
be executed in a longer cycle, so that, for example, the 
steps up to the generation of trajectories (corresponding to 
Steps SI to s4 in Fig. 4) are executed only when the floor 
contact state changes (boundary at which the robot is 
supported by both legs, one leg, or no legs) , and only the 
path interpolation steps and the step which follows (Steps 
S5 to S7 in the same figure) are executed every control 
period. However, in this case, a motion request is 
reflected less immediately. 

Although, in the embodiment, the motion state of the 
current time obtained from a previous generation of a whole- 
body motion is set as the initial condition of a generation 
of a whole-body motion of a next period in order to 
determine a motion state which smoothly connects to the 
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current motion state, the gist of the present invention is 
not limited thereto. For example, by measuring the actual 
motion state of the robot using, for example, the pelvis 
acceleration sensor Al and the gyro Gl, the sole sensors Fl 
5 to F8, the distance measuring sensors (Dl to D8) , the 

acceleration sensors A2 and A3, and the gyros G2 and G3, it 
is possible to form a control system which generates a 
whole-body motion reflecting the actual state like a robot 
walking controller disclosed in Nonpatent Document 5. 

10 

Supplement 

The present invention is described in detail while 
referring to a particular embodiment. However, it is 
obvious that modifications and substitutions may be made 
15 with regard to the embodiment by anyone skilled in the art 
within a scope not departing from the gist of the present 
invention. 

The gist of the present invention is not necessarily 
limited to a product called a "robot." In other words, the 
20 present invention may similarly be applied to a product of 
another industrial field, such as a toy, as long as the 
product is a mechanical device which moves like a human 
being by making use of electric or magnetic action. 

In short, the present invention has been described in 
25 terms of an embodiment, so that this is not to be construed 
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as limiting the content of the invention. In order to 
determine the gist of the present invention, the claims 
recited at the beginning should be referred to, 

5 Industrial Applicability 

The present invention can provide a device and a method 

for controlling the motion of an excellent legged mobile 

robot capable of seamlessly changing between 

walking/stopping states and running/hopping or jumping 
10 states while properly maintaining dynamic balance even 

during a change between irregular floor contact motion and 

floor non-contact motion. 

The present invention can also provide a device and a 

method for controlling the motion of an excellent legged 
15 mobile robot which can generate in real time a stable motion 

pattern for changing between a floor contact motion and a 

floor non-contact motion. 

First, since there are few limitations regarding 

mechanical models, the present invention is advantageous 
20 compared to inventions which, for example, assume that the 

legs are massless. (Refer to, for example, "Hanpuku Choyaku 

Model Biomechanism 5," 1985, published by University of 

Tokyo Press, Kiyotoshi Matsuoka, pp. 4501-4509; and the 

International Journal of Robotics Research, vol. 3, No. 2, 
25 1984, Marc H. Raibert and two other: "Experiments in 
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Balance with a 3D One-Legged Hopping Machine," pp. 75-92.) 
This is based on the fact that, according to the present 
invention, the mass point distribution state of the whole 
body is reflected in the dynamic constraints during both a 
5 floor contact period and a floor non-contact period. 

Present-day general legged mobile robots have a considerable 
number of actuators installed in the legs. Therefore, the 
masses of the legs cannot be ignored. Consequently, the 
present invention can be applied, particularly, to a 
10 humanoid robot having actuators providing six or more 
degrees of freedom per leg, and, thus, can be of wide 
application. 

Second, according to the present invention, the motion 
of a legged mobile robot having a floor contact period and a 

15 floor non-contact period can be controlled. Most of the 
related control systems of legged mobile robots control 
walking, and, thus, do not control a wider range of motions 
having a floor non-contact period, such as running and 
hopping. In contrast, according to the present invention, 

20 robots can realize more general motions in a case in which 
the robots walk, stop, run, hop, and jump. Therefore, 
legged mobile robots have considerably increased capability 
of covering a distance and of maintaining balance, so that 
they can, for example, jump over a gap, jump down from a 

25 higher level, or change their standing positions by hopping 



for maintaining balance. 

Third, according to the present invention, the use of 
the method based on using ZMP as a standard of determining 
stability (for example, refer to Nonpatent Document 1) is 
extended to general motions having a floor non-contact 
period, so that geometric constraints are easily imposed 
upon the trajectories of the end points of the legs. For 
example, desired values, such as footstep and period when 
running or heights of the soles when jumping, can be 
achieved while maintaining dynamic balance. In addition, 
the present invention is applicable to situations where 
constraints on the trajectories of the ends of the legs are 
important, such as running up steps or running while 
bringing a foot onto the floor in accordance with the widths 
of successive gaps obtained from viewing angle information. 
These motions are difficult to realize by a related motion 
controlling system which cannot impose geometric constraints 
on the trajectories of the end points. 

Fourth, since the present invention makes it possible 
to generate a dynamically stable motion pattern in real time, 
requests for changes in the motion of the upper body or for 
changes in crural motion, such as footstep, step period, 
traverse angle, and heights of soles, asynchronously input 
can be satisfied while dynamically maintaining balance, so 
that flexible and various motions having a floor non-contact 
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period and a floor contact period can be realized. It is 
very difficult to maintain dynamic stability while 
satisfying such outside requests by a method of previously 
generating a motion pattern offline or by related 
5 controlling systems which only maintain balance. 



